function [Matt] = Matt_calcu(Sensor_aim,Sensor_cur,Katt)

Matt=Katt.*atan((Sensor_aim-Sensor_cur)./(Katt*2));

end

